servo motor control fs-i6